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ABSTRACT 


This thesis compares two types of command guidance to be used by a point defence system: 
Proportional Navigation and Command to Line Of Sight (CLOS). The system block diagram was first 
defined. The necessary transfer functions were derived. Two forward time models were evaluated, 
one for each guidance method, using state variable analysis. Two three dimensional scenarios were 


defined and their results used to compare the two methods. Parameters considered in the comparison 


were miss distance and acceleration load on the missile. 
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2 ae INTRODUCTION 

The term "guidance" implies that the missile responds to 
steering commands in order to improve it’s accuracy in 
delivering the warhead. These commands issued to the missile 
can either be internal or external. When the commands are 
internal the missile incorporates a seeker that tracks the 
target and a guidance system that translates the target data 
to steering commands. This being the case, the missile is 
independent from the platform it was fired from. The name 
associated with this type of missile is "Fire and Forget". 
When the commands are external the target data can be 
collected by a Tracker/Fire Control System on the firing 
platform. The guidance system calculates the desired steering 
commands. These are transmitted to the missile. This implies 
that the missile is dependent on the firing platform 
throughout the encounter. Command is the name of this type of 
guidance. A generic system is shown in Figure 1 [Ref. 1: 
pp.27]. 

There are several types of guidance algorithms: 
proportional navigation, beam rider or command-to-LOS, etc. 

The missile incorporates an autopilot by which the signals 
are transformed, via actuators, into turning moments. 


The missile is assumed to maneuver via "skid-to-turn". 








MISSILE 





Figure 1. Generic Command Guidance System 


This is the case for tactical missiles. When the target is at 
long range, the missile may maneuver by a "bank-to-turn" 
Maneuvering law. This is a "minimum control effort" concept 
that increases the effectiveness of the fuel consumption and 
thus range. | 

This work develops a missile/target simulation program 
using proportional navigation and beam rider command 
guidance. A three dimensional model is constructed for a more 
realistic approach to the problem. Chapter II introduces the 
command guidance theory. Chapter III develops the transfer 


functions of the system, the problem geometry, and the 








relationships that are to be simulated. Chapter IV shows the 
development of the computer code and relays the simulation 
results. Chapter Vv discusses the conclusions and 
recommendations. 

This simulation uses MATLAB. The three dimensional plots 


are generated from GRAFTOOL. 














If. COMMAND GUIDANCE 


A. GENERAL 
Our initial approach will be two dimensional [Ref. 2]. 
Consider the geometry in Figure 2. The tracking radar (usually 


referred to as the illuminator) measures the following values: 


Ro The illuminator-to-missile range. 

R, : The illuminator-to-target range. 

ea The illuminator-to-missile line of sight 
angle. 








Figure 2. Fundamentals of Proportional Navigation Command 
and Command-to-Line-Of-Sight Guidance 








0, : The illuminator-to-target line of sight 
angle. 
CRE : The missile Cross Range Error from the 
target tracking beam. 
From these measurements, the Fire Control System solves for 


the following values 


R : The missile-to-target range. 

R': Rate of change of R. 

o : The missile-to-target line of sight 
angle. 

of 3 Rate of change of o. 


The guidance system of the Fire Control System now requires 


that an interception can occur. This can happen by driving: 


0 
0 (2.1) 


“A 


¢ 
R 
or, by driving: 
CRE = 0 
; (2.2) 
R< O 
More insight on these relationships in the next section. But, 
for now, the commands issued to the missile will affect the 
following values: 
Me Ss The missile velocity. 
yo the missile flight path angle. 
Finally, we know that the solution to the problem also depends 


on: 











vy : The target velocity. 
v : The target flight path angle. 
We will use here the Line of Sight (LOS) as that between 
the target and the missile. This so as to reduce the quantity 


of subscripts. 


B. INTERCEPTION THEORY 

The problem is to find a way by which the missile can hit 
the target. Figure 3 shows several techniques developed to 
solve this [Ref. 3: pp.349]. " Tail Chase", also known as 
"Pure Pursuit", is the trajectory run through by a missile 


aiming at the instantaneous position of the target. "Three 


(a). Tail Chase (b). Constant Bearing 





Figure 3. Interception Trajectories 











Point" is the trajectory run through by the missile requiring 
the three points: illuminator, missile and target to be on the 
same line (LOS) at all times. These two techniques require a 
highly maneuverable missile, able to withstand high 
accelerations, induced by the large change of the missile 
velocity vector, during the final seconds before impact (this 
period is usually referred to as the "“endgame"). 

Three point guidance is usually referred to as Command-to- 
Line-Of-Sight (CLOS). This is based on the minimization of the 
Cross Range Error (CRE);i.e. the displacement of the missile 
from the illuminator-to-missile line of sight. The theory of 
this technique is that since the three points are always on 
the same line and the missile-to-target distance is always 
shortening, these two are bound to meet. This explains the 
relationships of Equations 2.2 of the previous section. 

The simplest technique of all is the "Constant Bearing", 
also known as "Optimum Pursuit". The theory behind this 
technique is simple; if the missile "sees" the target at a 
constant bearing (o9’'=0) and if the distance between the two is 
continuously closing (R’<0), then the missile and target are 
bound to collide. This explains the relationships of Equations 
2.1 of the previous section. We define the closing velocity as 


the negative rate of the LOS range: 


v. = -R (2.3) 











The benefits of this technique lie in the smaller acceleration 
requirements during the endgame phase. Less missile energy is 
also required [Ref. 4: pp. 26]. The guidance law associated 
with this technique is called proportional navigation. 

We will first look at the importance of the LOS angle 
rate, since this is a major factor in this law. Miss distance 
is the minimum missile-to-target distance;i.e. it is the range 
at the Closest Point of Approach (CPA). Figure 4 displays the 
configuration examining the miss distance [Ref. 2: pp.33-34]. 


It can be defined as: 


Raiss = Min{R(t)] (2.4) 





Figure 4. Miss Distance Analysis 


From vector theory, a vector quantity 4 , rotating with an 
angular rate (a=do/dt) , is differentiated by the following 
law: 
3 = s + ox (2.5) 
We must note here that 0A/dt is a vector parallel to 
4 and that QxRk is perpendicular. This leads to the 


incorporation of the orthogonal components i, and i,, as can 
be seen in Figure 4. Also from the same Figure 4, we can see 
that, an incremental increase in the LOS angle (Ac), modifies 


the LOS range rate: 


ea a ee Oe Pa 
At Ae t° 
(2.6) 
= Ag + pas 
t E 





Taking the limit, of the above, as t-0, we have the derivative 

of the LOS range. Following the law of Equation 2.5 we get: 
R= £+axk (2.7) 

Finding the acceleration of this rate again requires the use 


of Equation 2.5, thus: 





Be «SO lat tes tates 
wae = gp (t+ 2x4) G(r +x) (2.8) 
Ro = £+26xL+O9xR+GxaxR 


This acceleration is the vectorial difference of the missile 


and target accelerations;i.e.: 


2 = £ (2.9) 


target Saissile 


Componentwise, in the cross-range direction (parallel to i,): 


@,-a, = (R6+2R0)i, (2.10) 


and in the range direction (parallel to i,): 


2,-a, = (R-RG*)i, (2.11) 


te “m, 


In order to have a successful intercept, the cross range rate 


of the LOS must be zero, thus from Equation 2.7, the 


quantity axk must be zero, implying either the LOS range 


or the LOS angle rate must be zero. The case of them being 
parallel is not physically attainable. Since the range is 
generally not equal to zero, we are left with the zero LOS 
angle rate. This implies that the LOS angle is constant and 
also proves the first part of Equation 2.1. Furthermore, 
Equations 2.10-11 show that constant LOS angle implies equal 
missile and target normal acceleration components. Radial 


acceleration components difference gives the closing 
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acceleration. We are now ready to develop the proportional 


navigation law. 


C. PROPORTIONAL NAVIGATION LAW 

The acceleration command (a,) issued to the missile, by 
the proportional navigation law, is perpendicular to the LOS. 
The actual missile acceleration (a,) is perpendicular to the 
missile’s velocity (v,). Figure 5 depicts these relationships 
{(Ref. 11: pp. 8-11]. We now seek a connection between the 
missile’s acceleration and its flight path angle. Figure 6 


depicts this relationship. Given the missile velocity at a 





Figure 5. Missile Accelerations 
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V{t+dt) 





dY¥ m 


0) 





Figure 6. Missile Acceleration/Flight Path Relationship 


time t(v,(t)), assume an acceleration (a,) applied on the 
missile for a period of dt. The velocity at the end of this 
period is thus v,(t+dt). The flight path angle has been 
changed by dy,,. Assuming a small angle approximation, a 


relationship can be stated as follows: 


a,dt = v,aY, - 
ih eny ay (2.12) 


Yn = NO (2.13) 


where N is the proportional navigation constant. The law 
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states that the rate of change of the missile’s flight path 
angle is proportional to the rate of change of the LOS angle. 


Substituting Equation 2.12 into Equation 2.13 yields: 


a, = V,Na (2.14) 


m 
The relationship connects the missile acceleration to the LOS 
angular rate. The navigation constant usually ranges between 


2 and 6. 


D. CLOS LAW 

The object of beam riding is to fly the missile along the 
beam that is continuously pointing at the target. The command 
to the missile is again an acceleration. From Figure 2 we 
have: 


CRE = R,Sin(o,-9,) (2.15) 


Thus the simplest implementation of a guidance law for a beam 
rider system the missile acceleration command (a,,4) must be 


proportional to the cross range error, thus: 
Aomg = K°CRE = K’‘R,Sin(o,-9,) (2.16) 


where K is the guidance gain [Ref. 2: pp. 45]. 
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IIt. SYSTEM DEVELOPMENT 


A. OVERVIEW 

In order to approach the simulation problem we will first 
develop a block diagram of the system. The transfer functions 
of each block will then be defined. The problem geometry for 
the specific application will then be developed. Finally the 
formulas that will be used in the simulation will be given. 

The generic block diagram of a command guidance system was 
given in Figure 1. A more specific block diagram is shown in 


Figure 7. 


Fire Control System 





Figure 7. System Block Diagram 
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B. TRACKER DEVELOPMENT 

A tracker receives the radar return from the target, and 
produces the illuminator-to-target range, and yaw and pitch 
angles. 

The yaw plane is defined as the xy-plane. The pitch plane 


is the vertical plane containing the target and the missile. 


1. Proportional Navigation 
The tracker geometry is shown in Figure 8. From this 
it can be seen that: 
o : The missile yaw angle 


The target yaw angle 





Figure 8. Proportional Navigation Tracker Geometry 
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Cog 3 The missile pitch angle 

De. The target pitch angle 

ee The illuminator-to-missile range 

R, : The illuminator-to-target range 

R The missile-to-target range, also known as 


the Miss Distance 
If the missile is defined by the triplet M(x,,y,,, Z,) 
and the target by the triplet T(x, y,,z,) then, the tracker 


calculates the following relations: 


Cinag = tan 22) 
‘m 
o = tan 7 
Cyan ‘ 
Z 
a. = tan? = 
‘pitch X 2 +y 2 (3.1) 
‘m m 
Z 
Cpitch = tan” : 
x+y, Ve 
Ra i Xm ey * Zm 
R, = X,2+y,2+2," 


These are the simulation equations. Inversely, if the tracker 


values are known, the triplets can be calculated as follows: 
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Xn = (REC OS F mn, 5 cn)/COSF my, 

Yn = (RnCos a ing,,,, 

Z, = R,SiNG., oo, os 
xX, = (R,COSG,._,)COSO, ; 
Ve = (F.coso.|_,)sino, | 

Zz, = R,sing, |, 


The tracker must produce the following values: 


pee :The missile-to-target yaw angle 
O pitch :The missile-to-target pitch angle 
R :The Miss Distance 


These values are shown in Figure 9. The above required 
quantities are incorporated in the solution frame. This is 
defined as the moving frame, always parallel to the reference 
frame, but originating on the missile. The additional 


equations required to be solved are: 





- : = YY, 
Oya = tan ieee 
. Z2,.-2 (3.3) 
Opitch = tan { = a : 
(X_- Xm) +(Ve — Ym) 
R= (X_- Xp)? +(Ve~ Vn) +(Ze- Zn) 


The combined set of Equations 3.3 are the output of 
the tracker for a proportional navigation fire control system, 


solving the three-dimensional interception. 
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Solution Frame 





Figure 9. Proportional Navigation Tracker Solution Frame 
Geometry 


2. CLOS 
In this scheme, the tracker is required to produce the 
cross range error. The tracker geometry is presented in Figure 
Bid 9a 
From analytic geometry, the distance of a point from 
a line, in 3D space, is given by (Ref. 6]: 


CRE| = CRE 


(3.4) 


In this case, the point is the missile and the line is the 


illuminator-to-target range. Substituting the triplets for the 
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Figure 10. CLOS Tracker Geometry 


missile, M(x,,y,,2Z,), and the target, T(x,y,,Z,), the following 


closed form solution for the cross range error, is derived: 





=x5y * (VnZe-Ve Zn)" = (2pXp- 2 (3.5) 





The CRE components in the yaw and pitch plane can also 


be calculated. Referring to Figure 10: 


CRE yay Xn , Yn sina Cyaw ~ O maw) 
2 : 
pitch =~ y CRE* i CRE yaw bn tall Ye 7 a | 


(3.6) 
CRE, 


The signum function is introduced in order to have a sign for 
the pitch cross range error. This sign is transferred to the 


commanded acceleration. 
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The combined set of Equations 3.5 and 3.6 are the 
output of the tracker for a command-to-line-of-sight fire 


control system, solving the three-dimensional interception. 


C. FILTER DEVELOPMENT 


1. Proportional Navigation 
Proportional navigation guidance requires the rate of 
change of the LOS angle. The filter estimates this rate from 
the LOS angle observed by the missile. 
The torque that will be applied to the missile will be 
analogous to this estimated angular acceleration of the LOS 


angle. The equation of motion describing the above is: 


T = TB (3 7) 
where: 
ee Control Torque 
i 6% Moment of Inertia 
B : Estimated LOS angular acceleration 


The input value to the filter is the LOS angle. The output 
value of the filter is its estimation of the angular 
acceleration. In between it calculates the angular velocity of 


the LOS. Thus solving for Equation 3.7 we get: 
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-k, (B-a) -k,B 


are 7 
ul 
KylKy 
ul 


(3.8) 
7 -kf -k,B+k,o 


where k,,k, are constants determined by the time constant used 
by the tracker. Laplace transformation transfers Equation 3.8 
from the time domain to the s-domain. Thus Equation 3.8 


transformed evaluates the filter transfer function: 


(s) _ et 
o(s) (s?+k,s+k,) (3.9) 
Assume the relationship: 
eee) eee epee ee 
2 2 
(s*+k,s+k,) (s+) (3.10) 
Ter 


For the system a time constant of 0.1 second was selected, 
since it approximates current technology. So the constants can 


be defined: 





(3.11) 


Ro 
a 


Ver 
The block diagram and S.F.G. of the filter is shown in Figure 


11. 
From Figure 11 it can be seen that two integrators are 


incorporated in the design. We can further analyze the system 
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(a) Block Diagram 


100 B 1/s p 








Figure 11. Proportional Navigation Filter Development 


in state-variable form to be described by the following: 
Xere = AgieXere + Bere Ure (3.12) 


where the control input matrix, for our scenario, is: 


Usie = Ig 


= | Oni a 
yaw 


(3.13) 


The vector contains the pitch and yaw plane 
estimations of the angle and its rate. Thus the vector can be 


written as: 
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pitch (3.14) 


The filter A and B matrices can then be written as: 


0 1 0 0 0 0 
_|-100 -20 0 0 100 O 

Age = 0 0 0 1 Brie 0 0 (3.15) 
0 QO -100 -20 Q 100 


This representation is from the continuous time domain, as it 
was transferred to the s-domain. Eventually it will be needed 


to descritize this, in order to run the computer simulation. 


2. CLOS 
It was shown previously, Chapter II Section D, that 
the cross range error, in a two-dimensional configuration, 


can be evaluated as: 
CRE = R,Sin(o,-0,) (2.15) 


It was also stated that this off-beam error will be used as an 
acceleration command. 

In order for good response characteristics to be 
obtained, some damping is required. A dynamic equation of the 


form 
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(CRE) = €@gng = K,'(CRE) + K,*(CRE) (3.16) 


needs to be satisfied. The error is thus filtered [Ref. 7: 
pp.12]. Laplace transformation transfers Equation 3.16 from 
the time domain to the s-domain. Thus Equation 3.16 


transformed evaluates the filter transfer function: 


CRE(Ss) 1 


Acoma (S) ” (k, $+k,) en) 
The filter gain constants (K,,K,) assumed here are: 
Ky = 325 
K, = -100 


These values are also representative of the current 
technology. 

The block diagram and S.F.G. of the filter is shown in 
Figure 12. From this it can be seen that two integrators are 
incorporated in the design. We can further analyze the system 


in state-variable form to be described by the following: 


Xere = AgieXeie (3.19) 
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(a) Block Diagram 


CRE js CRE 





Figure 12. CLOS Filter Development 


The vector contains the pitch and yaw plane 
estimations of the angle and its rate. Thus the vector can be 


written as: 


CRED; tch 


CRE... 
CRE. 


yaw 


The filter A matrix can then be written as: 


0 1 0 0 
-100 -25 0 0 
Age = 0 0 0 1 (3.21) 
0 Q -100 -25 
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This representation is from the continuous time domain, as it 


was transferred to the s-domain. Eventually it will be needed 


to descritize this, in order to run the computer simulation. 


D. GUIDANCE DEVELOPMENT 


1. Proportional Navigation 
The guidance subsystem must follow the proportional 
navigation law, as this was stated in Equation 2.13. The only 
difference would be that the estimation of the angular LOS 
rate is used instead of the actual LOS rate, since this is the 


input from the filter subsystem. Thus: 


Yn = NB (3.22) 


This is also the control input transmitted to the missile’s 
autopilot. 


The state variable representation, for our case, is: 


Mead = a oe. al 
Veyay A B yaw (3.23) 


2. CLOS 
A generic CLOS guidance would generate a missile 
acceleration equal to the estimated acceleration of the cross 


range error;i.e.: 
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(3.24) 


This will also be the control input transmitted to the 
missile’s autopilot. 
The state variable representation, for this case, is: 


Fond, seca = -25 -100 CRED i ech] | 0 0 CRE yaw 
Bemdyay 0 0 || CRE -25 -100}|CRE,,, 


‘pite. 


(3.25) 


E. AUTOPILOT DEVELOPMENT 


1. Proportional Navigation 

The autopilot determines the control (actuator 
position and thrust) necessary to perform the required 
command. In proportional navigation guidance, the missile 
commands are generated in order to change the missile flight 
path rate in proportion to the LOS rate. 

A simplified autopilot, would respond to the following 
argument [Ref. 5S: pp.17-19]. The applied torque about the 
missile center of gravity is proportional to the angular 
acceleration of the missile flight path. This, equation of 


motion , stated mathematically yields: 


(3.26) 


u 
Ny 
2 


Tapp cy Yn 


where: 
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Ts The applied torque 

eg The moment of inertia around the 
missile’s center of gravity 

+ ; The angular acceleration of the 


missile’s flight path 
The control torque, discussed in Chapter III Section 
C, may be different from the applied torque. Thus solving 


Equation 3.26 for the flight path acceleration: 
Yn = PR = -ky,, + KNB (3.27) 


where k is determined by the slowest time constant of the 
missile/autopilot. Laplace transformation transfers Equation 
3.27 from the time domain to the s-domain. Thus Equation 3.27 


transformed evaluates the autopilot transfer function: 


Ya's) 1 _kw (3.28) 


—_—————— = 


6 (s) s+k 
For the autopilot a time constant of 1.0 second was selected. 


So the constant can be defined: 


k = = 1 (3.29) 





The autopilot block diagram and S.F.G. are shown in 
Figure 13. From this it can be seen that although two 
integrators are incorporated in the design, only one output is 


fedback. We can further analyze the system in state-variavle 


28 

















a4 Y Y 


(a) Block Diagram 






Figure 13. Proportional Navigation Autopilot Development 


form to be described by the following: 


X,, + B.u (3.30) 


The vector contains the pitch and yaw plane flight 
path angular velocity estimations. Thus the vector can be 


written as: 
Yn, 
x = t oa 
ap es, (3.31) 


The autopilot A and B matrices can then be written as: 


(3.32) 
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The control input matrix is: 





B yaw (3.33) 


This representation is from the continuous time 
domain, as it was transferred to the s-domain. Eventually it 
will be needed to descritize this, in order to run the 
computer simulation. 

This direction change rate is converted to an 
acceleration command to the actuators. First, the missile 
velocity must be analyzed in the pitch and yaw plane. 
Referring to Figure 14, the missile velocity vector components 


can be stated as follows: 


m [Vm COS(Yn, - 9 ) 
pitch ( yy My, ) (3.34) 
Vitvaw = | Vn COSY a, | 
Then the acceleration components can be derived: 
an, tch = Lar os Ym: tch (3.35) 
Seas - Vinyaw Vityey 


The spatial accelerations are the same for the CLOS 


autopilot and are derived in the following Subsection 2. 
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Figure 14. Missile Velocity Relationships 


2. CLOS 
The acceleration commanded is distributed by the 
autopilot into the missile’s spatial accelerations. Referring 


to Figure 15: 


Xmeiccn = 2 mpieen® +2 pitcnCOS% yaw 
sn “Am .-,S1N p; tchSiNG yay (3.36) 
2 nips ta > Bias Petal tch 
and, Similarly, for the yaw plane: 
Xn = ~FimaySI NS yaw eer 
Varyay = “Ap, COS Ovaw 


From the above relationships, the autopilot states can be 


defined. These states, as well as those for proportional 
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Solution Frame 





Figure 15. Missile Acceleration Relationships 


navigation guidance, are the control inputs for the missile 


airframe. So, the following is concluded: 


ra 
xm Xn; tck “ns wv 

* 2 * ran? 
Yn Ymy; tch Viva (3 . 3 8 ) 
=m = Mpitch 


F. ACTUATOR DEVELOPMENT 
In the present model, and for both guidance cases, the 
assumption is made that the actuators, also known as control 


servos, directly convert the commanded rate to fin 














deflections. This being the case, the transfer function is 


unity. 


G. AIRFRAME DEVELOPMENT 


The missile vector is defined as the missile’s spatial and 


velocity components, namely: 





Thus the missile can be represented as: 


Xn = An Xp °, Bn Un 


The control input matrix is: 


Xm 
Un = (Yn 
= 


mM. 


Thus the A and B matrices can be written as follows: 


010000 000 
0090000 100 

A 000100 B _|0 0 0 
mi000000 mi0 10 
oo00001 000 
000000 001 


(3.39) 


(3.40) 


(3.41) 


(3.42) 


AS.F.G. representing the missile dynamics for the y-axis 


and for both guidances is shown in Figure 16. 
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H. KINEMATICS DEVELOPMENT 





The airframe development also defines the missile 
kinematics. The target kinematics are derived in a similar 
fashion. The target can be described by a state equation, 


namely: 


X, = A,X, + B,u, (3.43) 


where: 


x, = Ye (3.44) 


(3.45) 


oqQooo0o0o°o 
oooo0cor 
Qqoooo00o 
OoOroOO0Co 
OoOOoOro0o°o 
rPROODOOOO 


u, = [Ve (3.46) 
2. 

The target Gynende- equscious are defined with respect to 
the trajectory it follows; for example if the target is at 
level flight the accelerations are zero and so is the control 
Matrix. 


The S.F.G. for the target kinematics, for the y-axis, is 


shown in Figure 17. 
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(a) Proportional Navigation 





(b) Command-to-Line-Of-Sight 





Figure 16. Airframe Development (detail) 


I. SIMULATION DEVELOPMENT 

In order to simulate the system some variables are 
required for checking the results and the validity of the 
assumptions. Also the discretization of the system needs to be 


addressed. 


1. Additional Calculations 
The missile-to-target range (R) can also be defined 


as: 


R =vit (3.47) 


where: 


Vv : the closing velocity 
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Figure 17. Target Kinematics Development (Detail) 


t the time-to-go until impact;i.e. the 


go ¢ 
initial value must equal the total 
flight time (tcp,) 

The closing velocity was defined in Equation 2.3. 


Referring to Figure 18: 


Ve = -R = V, (3.48) 


‘yaw 


cos(y tae V, 5 COS(Yn,,, 9 


tyau) - Mya ya w) 


A similar analysis can be done in the pitch plane, but 
the idea is to subtract the missile and target velocity 
components parallel to the projection of the miss distance in 
either the yaw or the pitch plane. 


Thus the time-to-go can be calculated as: 


to = — Fz (3.49) 


2. System Discretization 
For a continuous time state-space system described by 


the following set of equations [Ref. 8]: 
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Figure 18. Closing Velocity Geometry 


Ax(t) + Bu(t) 
Cx(t) + Du(t) 


x(t) 
y(t) 


(3.50) 


a transformation into a discrete time system, with a T time 


interval, can be achieved: 


X(k+1) = ®x(k) + Pu(k) (3.51) 
y(k) = Cx(k) + Du(k) 
according to the transformation equations: 
® = eAT 
z 
r = ferae B (3.52) 
Q 








One way of calculating the matrix exponent is: 
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Y-1[ (sI-A) -4) 
c=T 


(3.53) 
Atr?.. AT? 
cl it leer ora eer Wa +... 


For the simulation the MATLAB function C2D.M is 
utilized. This function produces the ¢$ and Tf when the A and B 


matrices as well as the time interval (T) are specified. 
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A. 


Iv. SIMULATION RESULTS 


OVERVIEW 


The computer code for the proportional navigation command 


guidance is presented in Appendix 1, and that for the command- 


to-line-of-sight in Appendix 2. The assumptions that have been 


made throughout will be discussed. The two scenarios run and 


their results will also be presented. 


ASSUMPTIONS 


The following assumptions have been made throughout the 


analysis and simulation: 


The missile is not limited in accelerations. 

The acceleration due to gravity is ignored. 

The target is capable of instantaneous acceleration. 
The target has no upper acceleration limit. 

The proportional navigation constant is 4. 


The missile is pointed to the target at launch. 


ENGAGEMENT SCENARIOS 


1. Target at Steady, Level Flight 


For this scenario the target is flying at a constant 


altitude with no acceleration. The missile is fired from the 
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origin of the reference frame. The initial conditions of the 


missile states are: 


X, = 0 {ft] 


Vm = O [ft] 
Yn, = 0 [ft/sec] 
2.2: 10 [ft] 
Zz, = 0 [ft/sec] 


= 3000 [ft/sec] 





(4.1) 


The initial target states are such that the target would pass 


above the launching platform: 


xX, = 30000 [ft] 
X, = -999.445 [ft/sec] 
¥Y_ = 1000 [ft] 
Vy. =. =33.315 [ft/sec] 
Zz. = 500 {£t] 
Ze 0 [ft/sec] 


The target control matrix inputs are: 


X, = 0 [f£t/sec?] 
¥y., = 0 [ft/sec?] 
Zz, = 0 [ft/sec?] 


2. Maneuvering Target 


(4.2) 


(4.3) 


For this scenario the target is accelerating in all 


three directions. The missile is fired from the origin of the 








reference frame. The initial conditions of the missile states 


are: 


= 0 (£t] 
X, = 3000 [ft/sec] 


Yn = 0 [ft] 
(4.4) 
Y¥, = 0 [ft/sec] 
Z, = O [ft] 
Zoe 0 {ft/sec] 


The initial target states are such that the target would pass 


above the launching platform, if it was at level fight: 


x, = 30000 [ft] 
X, = -999.445 [ft/sec] 
Y, = 1000 (ft] 
(4.5) 
¥, = 733.315 [ft/sec] 
Z, = 900 [ft] 
2.°= 0 [ft/sec] 
The target control matrix inputs are: 
X, = -6.532.2siny,  [f£t/sec’] 
¥, = -6.5°32.2 COSY, (ft/sec?] (4.6) 
aa . 2 
2, = -0.1:32.2 cosy, [ft/sec*] 
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D. RESULTS 

Figures 19 through 38 display the output of the 
proportional navigation code for the first scenario. 

Figures 39 through 58 display the output of the 
proportional navigation code for the second scenario. 

Figures 59 through 80 display the output of the CLOS code 
for the first scenario. 

Figures 81 through 102 display the output of the CLOS code 


for the second scenario. 
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Figure 19. 
Go vs. Missile-to-Target Range 
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Figure 20. Proportional Navigation Scenario 13: 
and Target x-coordinate Time History 
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Proportional Navigation Scenario 1: 
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Figure 21. Proportional Navigation Scenario 13: 
and Target y-coordinate Time History 
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Figure 22. Proportional Navigation Scenario 1: 
and Target z-coordinate Time History 
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Figure 23. 





Figure 24. 


Miss Oistance vs. Time 
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Proportional Navigation Scenario 1: Missile 
and Target Velocity (x-component) Time History 
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Figure 25. 
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Figure 26. 





y~V@locity Time History 


Target 





4 


Time [sec] 


Proportional Navigation Scenario 1: Missile 
and Target Velocity (y-component) Time History 
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Proportional Navigation Scenario 1: Missile 
and Target Velocity (z-component) Time History 
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Missile Pitcn Angie vs. Time 
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Proportional Navigation Scenario 1: 
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Figure 28. Proportional Navigation Scenario 1: Missile 
Yaw Angle Time History 
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Figure 29. Proportional Navigation Scenario 1: Missile 
Pitch Rate Time History 
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Figure 30. Proportional Navigation Scenario 1: Missile 
Yaw Rate Time History 
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Figure 31. Proportional Navigation Scenario 1: Closing 
Velocity Time History 
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Figure 32. Proportional Navigation Scenario 1: Miss 
Distance and Time-of-Closest-Point-of Approach 
Enhancement Plot 
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Figure 33. Proportional Navigation Scenario 1: 


Missile 
Total Acceleration Time History 
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Figure 34. Proportional Navigation Scenario 13: 


Missile 
Acceleration (x-component) Time History 
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Figure 35. Proportional Navigation Scenario 1: Missile 
Acceleration (y-component) Time History 
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Figure 36. Proportional Navigation Scenario 1: Missile 
Acceleration (z-component) Time History 
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Figure 37. Proportional Navigation Scenario 1: Three- 
Dimensional Plot of the Engagement 
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Proportional Navigation Scenario 
Projection of the Engagement 
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Figure 39. Proportional Navigation Scenario 2: Time-To- 
Go vs. Missile-to-Target Range 
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Pigure 40. Proportional Navigation Scenario 2: Missile 
and Target x-coordinate Time History 
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Proportional Navigation Scenario 2: 
and Target y-coordinate Time History 
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Figure 42. Proportional Navigation Scenario 2: Missile 
and Target z-coordinate Time History 
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Figure 43. 
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Proportional Navigation Scenario 2: Miss 
Distance Time History 
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Proportional Navigation Scenario 2: Missile 
and Target Velocity (x-component) Time History 
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Figure 45. Proportional Navigation Scenario 2: Missile 
and Target Velocity (y-component) Time History 
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Figure 46. Proportional Navigation Scenario 2: Missile 
and Target Velocity (z-component) Time History 
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Figure 47. Proportional Navigation Scenario 2: Missile 
Pitch Angle Time History 
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Figure 48. Proportional Navigation Scenario 2: Missile 
Yaw Angle Time History 
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Proportional Navigation Scenario 2: Missile 
Pitch Rate Time History 
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Proportional Navigation Scenario 2: Missile 
Yaw Rate Time History 
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Figure 51. Proportional Navigation Scenario 2: Closing 
Velocity Time History 
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Figure 52. Proportional Navigation Scenario 2: Miss 


Distance and Time-of-Closest-Point-of Approach 
Enhancement Plot 
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Figure 53. Proportional Navigation Scenario 2: Missile 
Total Acceleration Time History 
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Proportional Navigation Scenario 2: Missile 


Figure 54. 
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Proportional Navigation Scenario 2: 
Acceleration (y-component) Time History 
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Figure 56. Proportional Navigation Scenario 2: Missile 
Acceleration (z-component) Time History 
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Figure 57. 


3D Plot of the Engagement 


Proportional Navigation Scenario 2: 
Dimensional Plot of the Engagement 
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Figure 58. Proportional Navigation Scenario 2: Yaw Plane 
Projection of the Engagement 
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Figure 59. Time-To-Go vs Missile-to- 
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Figure 60. CLOS Scenario 1: Missile and Target x- 
coordinate Time History 
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Figure 61. CLOS Scenario 1: Missile and Target y- 
coordinate Time History 
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Figure 62. CLOS Scenario 1: Missile and Target z- 
coordinate Time History 
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Figure 64. CLOS Scenario 
Velocity (x-component) Time History 
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Figure 65. CLOS Scenario ne Missile and Target 
Velocity (y-component) Time History ° 
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Figure 66. CLOS Scenario 1: Missile and Target 
Velocity (z-component) Time History 
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Figure 67. CLOS Scenario 1: Missile Pitch Angle Time 
History 
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Figure 68. CLOS Scenario 1: Missile Yaw Angle Time 
History 
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CLOS Scenario 13: Closing Velocity Time 
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CLOS Scenario 1: Miss Distance and Time-of- 
Closest-Point-of Approach Enhancement Plot 
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CLOS Scenario 1: Missile Total Acceleration 
Time History 
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CLOS Scenario 1: Missile Acceleration (x- 
component) Time History 
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Figure 73. CLOS Scenario 1: Missile Acceleration (y- 
component) Time History 


Missila z—Acceleration vs. Time 


udm [it/s-2| 





Time [sec] 





Figure 74. CLOS Scenario 1: Missile Acceleration (z- 
component) Time History 
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Figure 75. CLOS Scenario 1: Three-Dimensional Plot of 
the Engagement 





xy~Piane Projection of Encounter 


yous [ft] 





15 





x-axis [re] 





CLOS Scenario 1: Yaw Plane Projection of the 
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Figure 77. CLOS Scenario 1: Missile Cross Range Error 
(Yaw component) Time History 
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Figure 78. CLOS Scenario 1: Missile Cross Range Error 
(Pitch component) Time History 
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Figure 79. CLOS Scenario 1: Total Missile Cross Range 
Error Time History 
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Figure 80. CLOS Scenario 1: Total Commanded Missile 
Acceleration Time History 
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Figure 81. CLOS Scenario 2: Time-To-Go vs. 


Target Range 
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Figure 82. CLOS Scenario 2: 
coordinate Time History 
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Figure 83. CLOS Scenario 2: Missile and Target 
coordinate Time History 
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Figure 84. CLOS Scenario 2: Missile and Target z- 
coordinate Time History 
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Figure 85. CLOS Scenario 2: Miss Distance Time History 
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: Figure 86. CLOS Scenario 2: Missile and Target 
Velocity (x-component) Time History 
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CLOS Scenario 2: Missile and Target 
Velocity (y-component) Time History 
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Figure 88. CLOS Scenario 2: Missile and Target 
Velocity (z-component) Time History 
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Figure 89. CLOS Scenario 2: Missile Pitch Angle Time 
History 
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Figure 90. CLOS Scenario 2: Missile Yaw Angle Time 
History 
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Figure 91. CLOS Scenario 2: Closing Velocity Time 
History . 
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Pigure 92. CLOS Scenario 2: Miss Distance and Time-of- e 
Closest-Point-of Approach Enhancement Plot 
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CLOS Scenario 2: 
Time History 


Figure 93. Missile Total Acceleration 
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Figure 94. CLOS Scenario 2: Missile Acceleration (x- 
component) Time History 
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Figure 95. CLOS Scenario 2: Missile Acceleration (y- 
component) Time History 


Missile z—Acceleration vs. Time 








Pigure 96. CLOS Scenario 2: Missile Acceleration (z- 
component) Time History 
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3D Plot of the Engagement 





Figure 97. CLOS Scenario 2: MThree-Dimensional Plot of 
the Engagement 
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Figure 98. CLOS Scenario 2: Yaw Plane Projection of the 
Engagement 


86 








Time [sec] 





Figure 99. CLOS Scenario 2: Missile Cross Range Error 
(Yaw component) Time History 
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Figure 100. CLOS Scenario 2: Missile Cross Range Error 
(Pitch component) Time History 
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Figure 101. CLOS Scenario 2: Total Missile Cross Range 
Error Time History 
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Figure 102. CLOS Scenario 2: Total Commanded Missile 
Acceleration Time History 
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A. COMPARISONS 


1. Scenario 1 

For the case of the level flying target the 
proportional navigation algorithm gave (after a few computer 
runs) the following results: 

@® Miss Distance 31.7 [ft] 
@ tcp, 7-52 [sec] 
The CLOS algorithm gave: 
@® Miss Distance 19.3 [ft] 
@ top, 7-57 [sec] 

The difference in miss distance can be found in the 
missile acceleration. The total missile acceleration plots 
show the absolute values. Whereas the proportional navigation 
guidance commands large values in the first second of flight, 
these values are much smaller than those commanded by the 
CLOS. In the case of the CLOS, these commands are issued each 
time the missile is off-beam. Also, when the illuminator-to- 
target and illuminator-to-missile ranges are of the same 
order, range resolution requires more off-beam (CRE) error. 
Then the commanded acceleration values are even higher than 
before. The total CRE, at the time of closest point of 


approach, is then the miss distance. 
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There is no distinct difference in the total flight 


time, but all computer runs showed a consistent lower flight 


time for the proportional navigation guidance in the order of 


hundredth of a second. 


2. Scenario 2 


For the case of the maneuvering target 


the 


proportional navigation algorithm gave (after a few computer 


runs) the following results: 
® Miss Distance 63.4 [ft] 
@ top, 7.20 [sec] 
The CLOS algorithm gave: 
@® Miss Distance 12.1 [ft] 
@ top, 7.21 [sec] 
The same miss distance analysis, outlined in 


previous subsection, holds here also. But in this case, 


the 


the 


proportional navigation guidance gives a much higher miss than 


that of the CLOS. 


The large acceleration demands impose large pitch and 


yaw angles. These, in turn, modify the velocity vectors, and 


finally the trajectory. 
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Vv. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 

Although the proportional navigation scheme may be an 
excellent tool for inertial guided missiles, command guidance 
offers attractive alternates. 

In the case of beam riding, the missile does not require 
a seeker, thus reducing the unit production cost. On the other 
hand, the illuminator is required to remain occupied with the 
target until intercept. Also the accuracy varies inversely 
proportional with the range of intercept;i.e. targets engaged 
close to the illuminator produce higher range resolution than 
targets further away. 

The algorithms developed provide an insight to the two 
different guidances. Proportional navigation gave higher miss 
distances as the target increased its maneuverability, whereas 


CLOS remained consistent throughout. 


B. RECOMMENDATIONS 
The application of an acceleration limit, would be an easy 
addition to the algorithms and would provide further insight 


to the comparison. 
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The implementation of noise in the measured angles, would 


further approximate real world conditions. 

A Monte Carlo statistical analysis, would provide a 
further insight to the accuracy of the results. 

Finally, an adjoint model analysis, would provide an 


excellent result validation tool. 
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APPENDIX A - PROPORTIONAL NAVIGATION CODE 


$Title 
sAuthor 
sDate 
Revised 
Project 
sSystem 
sCompiler 
Description 
% 

% 


% 


clg 


clear 


!del cg*.met; 
!del cg3dm.dat; 


!del cg3dt.dat; 


cle 


Three (3) dimensional Command 
Guidance (PN) 

Dimitrios Peppas 

10/01/92 

12/01/92 

Thesis 

Legend 386SX 

386 - MATLAB v.: 3.5m 

This code solves a 3D target/missile 
problem using a proportional navigation 
command guided missile (Forward Time 


Model) . 


runtime=clock; %Iinitialization for calculation of runtime 


rtod=180/pi; 


flops (0); 


%Rad-to-Degree Conversion factor 


Reset Floating Point Operations Counter 
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%STATE DEFINITIONS 


Missile 


sms = [xm missile 
% xdm missile 
% ym missile 
% ydm missile 
% zm missile 
% zdm} missile 
sum=[xddm missile 
% yddm missile 
% zddm] missile 
Recall 
AM=[0 1 000 

0 0 00 0 

00 5 Rea 3 aaa 

0 0 000 

0 0 001 

0 0 0.00) 
BM=[0 0 

1 0 

0 0 

01 

0 0 

6.0L 1g 


coordinate 
velocity 
coordinate 
velocity 
coordinate 
velocity 
acceleration 
acceleration 


acceleration 


[ft] 
[ft/s] 
[ft] 
[ft/s] 
[ft] 
[ft/s] 
[ft/s*2] 
[f£t/s*2] 


[ft/s*2] 


(ms) dot=AM* (ms) +BM*um 
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sTarget 


$ts=(xt target x coordinate [ft] 

% xdt target x velocity {ft/s} 

% yt target y coordinate (ft) 

% ydt target y velocity {ft/s] 

% zt target z coordinate (ft) 

% zdt] target z velocity [ft/s] 
%ut=(xddt target x acceleration fetj/s* 2] 
% yddt target y acceleration [ft/s*2] 
% zddt] target z acceleration [f£t/s*2] 
Recall : (ts) dot=AT* (ts) +BT*ut 
AT=AM; 

BT=BM; 


sT ime and Navigation Constants 


sttrack F.C.S. tracking constant [sec] 
stmc F.C.S. missile command constant [sec] 
tN F.C.S. Navigation constant [dimensionless] 


ttrack=0.1; 
tmc=1; 

N=4; 
k1l=(1/ttrack) *2; 
k2=(2/ttrack) ; 
k=(1/tmc) ; 


$F.C.S. TrackerandFilter 
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strks=[beta_pitch Tracker pitch angle estim. {rad] 
% betad_pitch Tracker pitch rate estim. [rad/s] 
% beta_yaw Tracker yaw angle estim. [rad] 
% betad_yaw] Tracker yaw rate estim. ([rad/s] 
sutr=[sigma_pitch Missile-to-Target pitch angle [rad] 
% sigma_yaw] Missile-to-Target yaw angle [rad] 
ATR=[ 0 1 0 0 
-k1 -k2 0 0 
0 0 60 1 
0 0 -k1l -k2); 
BTR= [0 0 
k1 0 
0 0 
0 kil1j; 
Recall (trks) dot=ATR*trks+BTRtutr 
% This is Equation (3.12) 
$F.C.S. Guidance and Autopilot 
smc=[(gammad_pitch Missile pitch rate command [rad/s] 
% gammad_yaw] Missile yaw rate command [rad/s] 


sumc= [betad_pitch 


% betad_yaw] 
AMC=[-k 0 

0 -k); 
BMC={[N 0 
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ON]; 


Recall : (mc) dot=AMC*mc+BMC*ume 


% This is Equation (3.30) 
sDiscretizgation 

dt=.01; Integration Interval 
(phim, delm] =c2d (AM, BM, dt) ; 

{phit,delt] =c2d(AT,BT,dt) ; 
{(phitr,deltr] =c2d (ATR, BTR, dt) ; 
(phimc,delmc] =c2d (AMC, BMC, dt) ; 

tfinal=15.0; Calculation time range 
kmax=tfinal/dt+1; %Maximum main loop runs 
*Initializgation 


ms(:,1)=[ 0 


0 

0 |; 
ts(:,1)=[30000 ’ 

-999.445 

1000 

-33.315 

500 


0 Le 
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{sec] 


{sec] 








Rt (1) =sqrt (ts(1,1)*2+ts(3,1)*2+ts(5,1)%2); 


Rm(1) =sqrt (ms (1,1) *2+ms(3,1)*2+ms(5,1)%2); 
R(1)=sqrt ((ms(1,1)-ts(1,1))*2+(ms(3,1)-ts(3,1))*2+... 
(ms (5,1)-ts(5,1))%2); 
time (1) =0; 
Simulation 
for (i=1:kmax-1) 
% Missile and Target Velocities 
vt (i) =sqrt (ts(2,i)*2+ts(4,i)*2+ts(6,i)*2); 
vm(i) =sqrt (ms (2,i)*2+ms(4,i)*2+ms(6,i)*2) ; 
% Lines-of-Sight 
sigmam_pitch(i)=atan2(ms(5,i),sqrt(ms(1,i)*2+... 
ms (3,i)*2)); 
sigmat_pitch(i) =atan2(ts(5,i),sqrt(ts(1,i)%2+. 
ta(3,1).°2)); 
sigmam_yaw(i)=atan2(ms(3,i),ms(1,i)); 
sigmat_yaw(i) =atan2(ts(3,i),ts(1,i)); 


sigma_pitch (i) satan2((ts(5,i)-ms(5,i)),... 
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oe 





sqrt ((ts(1,i)*2-ms(1,i)*2)+... 
(ts (3,1) 22ms(374)72))); 
sigma_yaw(i) =atan2((ts(3,i)-ms(3,i)), (ts(1,i)-ms(1,i))); 
utr=(sigma_pitch (i) 
sigma_yaw(i) 1]; 
F.C.S. Tracker update 
trks(:,i+1l)=phitr*trks(:,i)+deltr*utr; 
F.C.S. Missile Command Control update 
umc= [trks (2,1) 
trks(4,1i)]; 
Missile and Target Flight Path angles 
gammam_pitch(i)=atan2(ms(6,i),... 
sqrt (ms(2,i)*2+ms(4,i)*2)); 
gammat_pitch(i)=atan2(ts(6,i),... 
sqrt (ts(2,i)*2+ts(4,i)*2)); 
gammam_yaw(i)=atan2(ms(4,1),ms(2,i)); 
gammat_yaw(i) =atan2(ts(4,1),ts(2,i)); 
F.C.S. Missile Command update 
mc (:,i+1)=phime*mc(:,1)+delmc*umc; 
Missile Velocity and Acceleration in Pitch Plane 
vm_pitch (i) =vm(i) *cos (gammam_yaw(i) -sigmam_yaw(i) ) ; 
am_pitch(i)=vm_pitch(i)*mc(1,i); 


Missile Pitch Acceleration components 


xddm_pitch(i)=-am_pitch(i)*sin(sigma_pitch(i))*... 





oe? 





cos (sigma_yaw(i)); 


yddm_pitch(i)=-am_pitch(i)*sin(sigma_pitch(i))*... 
sin(sigma_yaw(i)); 
zddm_pitch(i)=am_pitch(i)*cos(sigma_pitch(i)); 
Missile Velocity and Acceleration in Yaw Plane 
vm_yaw (i) =vm(i)*cos(gammam_pitch(i)) ; 
am_yaw(i) =vm_yaw(i)*mc(2,i); 

Missile Yaw Acceleration components 
xddm_yaw(i)=-am_yaw(i)*sin(sigma_yaw(i)); 
yddm_yaw(i)=am_yaw(i) *cos(sigma_yaw(i)); 

Missile Acceleration components 
xddm (i) =xddm_pitch (i) +xddm_yaw(i); 
yddm(i) =yddm_pitch (i) +yddm_yaw(i) ; 
zddm(i)=zddm_pitch(i); 
um= [xddm (i) 

yddm (i) 
zddm(i)]j; 
am(i) =sqrt (um(1)*2+um(2) *2+um(3)*2) ; 

‘Missile update 
ms (:,i+1)=phim*ms(:,i)+delm*tum; 

Target Acceleration components 
xddt (i) =0;%-6.5*32.2*sin(gammat_yaw(i)); 
yddt (i) =0;%-6.5*32.2*cos(gammat_yaw(i)); 


zddt (i) =0;%-0.1*32.2*cos(gammat_pitch(i)); 
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oe 


ov? 


oe 


oe 


ut=[xddt (i) 
yddt (i) 
zddt (i)]; 
at (i) =sqrt (ut (1) *2+ut (2) *2+ut(3)%2); 
Target update 
ts(:,i+1)=phit*ts(:,i)+delt*ut; 
Time-to-go 


vt_yaw(i)=vt(i)*cos(gammat_pitch(i)); 


vce (i)=- (vt_yaw(i) *cos(gammat_yaw(i)-sigma_yaw(i))... 


-vm_yaw(i) *cos (gammam_yaw(i)-sigma_yaw(i))); 
ttg(i)=R(i)/ve(i); 
Range update 
Rt (i+1) =sqrt (ts(1,i+1)*2+ts(3,i+1)*2+ts(5,i+1)%2); 
Rm(i+1) =sqrt (ms (1,i+1)*2+ms (3,i+1)*2+ms(5,i+1)*2); 
R(i+1)=sqrt ((ms(1,i+1)-ts(1,i+1))*2+.. 
(ms (3,i+1)-ts(3,i+1))*2+.. 
(ms (5,i+1)-ts(5,i+1))%*2); 
Time update 
time (i+1) =time (i) +dt; 
Rmiss check 
if (R(i) < R(it+l)) 
tcpa=time (i); $Time-of-C.P.A. 
break 


end 


101 


TY 


end 
flop _count=flops; 


runtime=etime (clock, runtime) 


Y=[es(i,2)* ts(3,s) rsi(o,s)" 13 
save cg3dm.dat X /ascii ; 

save cg3dt.dat Y /ascii ; 
tPrintouet 

plot (ttg(1:i-1),R(1:i-1)); 


title(’Miss Distance vs. Time-to-go’); 





xlabel(’TTG [sec]');ylabel(’Rmiss [{ft]’); 
meta cgl 


pause 


clg 

plot (time,ts(1,:),time,ms(1,:)); 
title(’x-coordinate Time History’) ; 
xlabel(’Time [sec]’) ;ylabel(’x-coord. [{ft]’); 
gtext (‘Missile’) ;gtext(’Target’); 

meta cg2 


pause 


clg 
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plot (time,ts(3,:),time,ms(3,:)); 


title(’y-coordinate Time History’); 


xlabel(’Time [sec]’);ylabel(’y-coord. 


gtext (‘Missile’) ;gtext(’Target’); 
meta cg3 


pause 


clg 
plot (time,ts(5,:),time,ms(5,:)); 


title(’z-coordinate Time History’) ; 


xlabel(‘Time [sec]’) ;ylabel (’z-coord. 


gtext (’Missile’) ;gtext(’Target’); 
meta cg4 


pause 


clg 
plot (time,R) ; 


title(’Miss Distance vs. Time’) ; 


ce oa Be 


eh oe laa 


xlabel(’Time [{sec]’);ylabel(’Rmiss [ft]’); 


meta cg5 


pause 


clg 


plot (time,ts(2,:),time,ms(2,:)); 
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title('x-Velocity Time History’); 
xlabel(’Time [sec]’);ylabel('’Vx [ft/s]’‘); 
gtext (’Missile’) ;gtext(’Target’); 

meta cg6é 


pause 


clg 

plot (time,ts(4,:),time,ms(4,:)); 
title(’y-Velocity Time History’); 

xlabel (‘Time [sec]’);ylabel(’Vy [ft/s]’); 
gtext (‘Missile’) ;gtext(’Target’) ; 

meta cg7 


pause 


clg 

plot (time,ts(6,:),time,ms(6,:)); 
title(’z-Velocity Time History’); 
xlabel(’Time [sec]’);ylabel(’vz [ft/s]’); 
gtext (’Missile’) ;gtext (‘Target’) ; 

meta cg8 


pause . 


clg 


plot (time (1:i) ,rtod*gammam_pitch) ; 











title(’Missile Pitch Angle vs. Time’); 


xlabel('Time [sec]’);ylabel(‘gammam_pitch [deg]}’); 
meta cg9 


pause 


clg 
plot (time (1:1) ,rtod*gammam_yaw) ; 


title(’Missile Yaw Angle vs. Time’); 


xlabel('Time [sec]’) ;ylabel(’gammam_yaw [deg] '); 
meta cg10 

pause 

clg 


plot (time, rtod*mc(1,:)); 
title(’Missile Pitch Rate vs. Time’); 


xlabel(’Time [sec]’) ;ylabel(’gammamd_pitch [deg/s]'); 





meta cg11 


pause 


clg 

plot (time, rtod*mc(2,:)); 

title(’Missile Yaw Rate vs. Time’); 

xlabel('Time [sec]’);ylabel(’gammamd_yaw [deg/s] ') ; 


meta cg12 
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pause 


%Following plots were not included in the documentation 
$clg 

plot (time (1:1) ,rtod*gammat_pitch) ; 

$title(’Target Pitch Angle vs. Time’); 
sxlabel(’Time [sec]’);ylabel(’gammat_pitch [deg]’); 
meta cg13 

spause 

%Clg 

plot (time(1:i),rtod*gammat_yaw) ; 

title(’Target Yaw Angle vs. Time’); 

txlabel(’Time [{sec]’);ylabel(‘gammat_yaw [deg] ’)j; 
meta cgi4 


pause 


clg 

plot (time (1:1) ,vc); 

title(’Closing Velocity vs. Time’); 

xlabel (‘Time [sec]’);ylabel(‘vc [ft/s]'); 

meta cg15 . 


pause 


clg 
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axis([tcpa-.1 tcpa+.1 0 min(R)+20]); 

plot (time,R) ; 

title(‘Rmiss "Zoom" Plot’) ;axis; 
xlabel(’'Time [sec]’);ylabel(’Rmiss [ft]'); 
meta cgl16 


pause 


clg 

plot (time(1:i),am); 

title(’Total Missile Acceleration vs. Time’); 
xlabel(’Time [sec]');ylabel(’am [ft/s*2]'); 
meta cg17 


pause 


clg 

plot (time (1:i) ,xddm) ; 

title(’Missile x-Acceleration vs. Time’) ; 
xlabel (‘Time [sec]’);ylabel(’xddm [ft/s*2]’); 
meta cg18 ’ 


pause 


clg 
plot (time (1:1) ,yddm) ; 


title(’Missile y-Acceleration vs. Time’); 








xlabel (‘Time [sec]');ylabel(’yddm [ft/s*2]’); 
meta cgl19 


pause 


clg 

plot (time (1:2) ,zddm) ; 

title(‘’Missile z-Acceleration vs. Time’); 
xlabel(’Time [sec]’);ylabel(‘zddm [ft/s*2]'); 
meta cg20 


pause 


Following plots were not included in the documentation 
$clg 

plot (time(1:i),at); 

$title(’Total Target Acceleration vs. Time’); 
¢xlabel(’Time [sec]’);ylabel(’at [ft/s*2]’); 
meta cg21 

‘pause 

%clg 

plot (time (1:1) ,xddt) ; 

stitle(’Target_ x-Acceleration vs. Time’); 
txlabel(’Time [sec]');ylabel(’xddt [ft/s*2]'); 
smeta cg22 


$pause 
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$clg 

splot (time (1:i) ,yddt) ; 

stitle(’Target y-Acceleration vs. Time’); 
xlabel(’Time [sec]’);ylabel(’yddt [ft/s*2]’); 
meta cg23 

spause 

sclg 

splot (time(1:i),zddt) ; 

stitle(’Target z-Acceleration vs. Time’); 
sxlabel(’Time [sec]’);ylabel(’zddt [ft/s*2]’); 
meta cg24 


pause 


clg 

plot tts (1, <4,,ts (3.2) 57° 2" me (Ly ymet3; 2) g's 
title('xy-Plane Projection of Encounter’) ; 
xlabel('x-axis [ft]’);ylabel(’y-axis [ft]’); 


meta cg26 
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APPENDIX B - CLOS CODE 


Title Three (3)D Command Guidance (CLOS) 
sAuthor Dimitrios Peppas 

$Date 10/01/92 

$Revised 11/30/92 

*Project Thesis 

sSystem Legend 386SX 

Compiler 386 - MATLAB v.: 3.5m 

sDescription This code solves a 3D target/missile 
% problem using a command-to-line-of-sight 
% command guided missile (Forward Time 

% Model). 

clg 

clear 


!del clg*.met; 
!del cl3dm.dat; 
!del cl3dt.dat; 


cle 


runtime=clock; Initialization for calculation of runtime 


rtod=180/pi; tRad-to-Degree Conversion factor 


flops (0) ; Reset Floating Point Operations Counter 
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SSTATE DEFINITIONS 


‘Missile 


$ms= [xm 

% xdm 
% ym 

% ydm 
3 zm 

% zdm] 
Sum= [xddm 
% yddm 
% zddm] 
Recall 


AM=[0 1000 0 
000000 


000100 


missile 
missile 
missile 
missile 
missile 
missile 
missile 


missile 


x 


y 


coordinate 
velocity 
coordinate 
velocity 
coordinate 
velocity 
acceleration 


acceleration 


missile z acceleration 


(ms) dot =AM* (ms) +BM*um 
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(ft] 
[ft/s] 
[fel 
[ft/s] 
[ft] 
[ft/s] 
[ft/s*2] 
[ft/s*2] 


(ft/s*2] 








‘ts=(xt target 
% xdt target 
% yt target 
% ydt target 
% zt target 
% zdt] target 
sut= [xddt target 
% yddt target 
% zddt ] target 
Recall 

AT=AM; 

BT=BM; 


coordinate 
velocity 
coordinate 
velocity 
coordinate 
velocity 
acceleration 
acceleration 


acceleration 


(ts) dot=AT* (ts) +BT*ut 


tDiscretiz#ation 


dt=.01; tIntergration Interval 


(phim, delm] =c2d (AM, BM, dt) ; 


[phit,delt] =c2d(AT, BT, dt) ; 


tfinal=15.0; 


Calculation time range 


kmax=tfinal/dt+1; %tMaximum main loop runs 


Initialization 


ms(:,1)=[ eps 
3000 
eps 


0 
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(ft) 
[ft/s] 
(ft) 
[ft/s] 
(ft] 
[ft/s] 
[ft/s*2] 
[ft/s*2] 


[ft/s*2] 


[sec] 


[sec] 











ts { 


0 


0 Ts 


:,1)={[30000 


-999.445 
1000 

-33.315 
900 


0 Jj; 


Rt (1) =sqrt (ts(1,1)*2+ts(3,1)*2+ts(5,1)%2); 


Rm(1 


)=sqrt (ms (1,1)*2+ms(3,1)*2+ms(5,1)*2); 


R(1)=sqrt ((ms(1,1)-ts(1,1))*2+(ms(3,1)-ts(3,1))*2+(ms(5,1)-t 


s(5, 


Ly)" 2)% 


time (1) =0; 


Simulation 


for 


r) 
x 


oe 


(i=1:kmax-1) 
Missile and Target Velocities 
vt (i) =sqrt (ts(2,i)*2+ts(4,i)*2+ts(6,i)%*2); 
vm(i) =sqrt (ms (2,i)*2+ms(4,i)*2+ms(6,1i)*2); 
Lines-of-Sight 


sigmam_pitch(i)=atan2(ms(5,i),... 





sqrt (ms (1,i)*2+ms(3,i)*2)); 
sigmat_pitch(i)=atan2(ts(5,i),... 
sqrt (ts(1,i)*2+ts(3,i)*2)); 


sigmam_yaw(i) =atan2 (ms (3,1i),ms(1,1)); 
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sigmat_yaw(i) =atan2(ts(3,i),ts(1,1i)); 


sigma_pitch (i) =atan2((ts(5,i)-ms(5,i)),... 
sqrt ((ts(1,i)*2-ms(1,i)*2)+.. 
(ts(3,i)*2-ms(3,i)*2))); 
sigma_yaw(i) =atan2((ts(3,i)-ms(3,i)), (ts(1,i)-ms(1,1i))); 
% C.R.E. and (C.R.E.)' 
gla=(ms(3,i)*ts(5,i)-ms(5,i)*ts(3,1)); 
glb=- (ms(5,i)*ts(1,i)-ms(1,1)*ts(5,1)); 
gic=(ms(1,i)*ts(3,i)-ms(3,i)*ts(1,i)); 
gl=gla*2+glb*2+glc*2; 
g2a=2*gla* (ms (4,i)*ts(5,1)+ms(3,1i)*ts(6,i)-... 
ms (6,i)*ts(3,i)-ms(5,1i1)*ts(4,1i)); 
g2b=2*g1lb* (ms (6,1) *ts(1,i)+ms(5,i)*ts(2,i)-... 
ms (2,i) *ts(5,i)-ms(1,i)*ts(6,i)); 
g2c=2*glic* (ms (2,1) *ts(3,i)+ms(1,i)*ts(4,i)-... 
ms (4,i)*ts/1,i)-ms(3,i)*ts(2,i)); 
g2=g2at+g2b+g2c; 
£2=(ms(1,i)*ms(2,i)+ms(3,i)*ms(4,i)+... 
ms (5,i)*ms(6,i))/Rt (i); 
CRE (i) =sqrt (g1)/Rt (i); 
CRED (i) =( (1/2) * (g2/sqrt(g1))*Rt(i)-... 
f2*sqrt (g1))/(Rt(i)*2); 
CRE_yaw(i) =sqrt (ms(1,i)*2+ms(3,i)*2)*... 


sin(sigmat_yaw(i) -sigmam_yaw(i)); 
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oe 





CRE_pitch(i) =sqrt (CRE(i)*2-CRE_yaw(i)“*2)*. 


sign(sigmat_pitch(i)-sigmam_pitch(i)); 
Missile and Target Flight Path angles 

gammam_pitch(i)=atan2(ms(6,i),... 

sqrt (ms(2,i)*2+ms(4,i)*2)); 
gammat_pitch(i)=atan2(ts(6,i),.. 

sqrt (ts(2,i)*2+ts(4,i)*2)); 
gammam_yaw(i)=atan2(ms(4,1i),ms(2,i)); 
gammat_yaw(i)=atan2(ts(4,1),ts/? i)); 

Acceleration Command 
acmd_yaw(i)=-100*CRE_yaw(i) -25*CRED (i); 
acmd_pitch(i)=-100*CRE_ pitch(i) -25*CRED(i) ; 

Missile Velocity and Acceleration in Pitch Plane 
vm_pitch (i) =(vm(i) *cos (gammam_yaw(i)-sigmam_yaw(i))); 
am_pitch(i)=-acmd_pitch (i); 

Missile Pitch Acceleration components 
xddm_pitch(i)=-am_pitch(i)*sin(sigma_pitch(i))*... 
cos (sigma_yaw(i)); 
yddm_pitch(i)=-am_pitch(i)*sin(sigma_pitch(i))*... 
sin(sigma_yaw(i)); 
zddm_pitch(i)=am_pitch(i) *cos(sigma_pitch(i)); 
Missile Velocity and Acceleration in Yaw Plane 
vm_yaw(i) =vm(i) *cos (gammam_pitch(i)); 


am_yaw(i) =-acmd_yaw(i) ; 
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oe 


ae 


ae 


Missile Yaw Acceleration components 
xddm_yaw(i)=-am_yaw(i) *sin(sigma_yaw(i)); 
yddm_yaw(i)=am_yaw(i) *cos(sigma_yaw(i)); 

Missile Acceleration components 
xddm(i)=xddm_pitch(i)+xddm_yaw(i); 
yddm(i)=yddm_pitch (i) +yddm_yaw(i) ; 
zddm(i)=zddm_pitch(i); 
um= [xddm (i) 

yddm (i) 
zddm(i)]; 
am(i) =sqrt (um(1) *2+um(2) *2+um(3)*2); 

Missile update 
ms (:,i+1)=phim*ms (:,i)+delm*um; 

Target Acceleration components 
xddt (i) =-6.5*32.2*sin(gammat_yaw(i)) ;%0; 
yddt (i) =-6.5*32.2*cos (gammat_yaw(i) ) ;%0; 
zddt (i) =-0.1*32.2*cos (gammat_pitch(i)) ;%0; 
ut=[xddt (i) 

yddt (i) 
zddt (i)]; 
at (i) =sqrt (ut (1) *2+ut (2) *2+ut (3) *2); 

Target update 

ts(:,i+1)=phit*ts(:,1)+delt*ut; 


Time-to-go 








vt_yaw(i) =vt (i) *cos(gammat_pitch(i)); 


vc (i) =- (vt_yaw(i) *cos (gammat_yaw(i)-sigma_yaw(i))-. 


vm_yaw (i) *cos (gammam_yaw(i)-sigma_yaw(i))); 


ttg(i)=abs(R(i)/vc(i)); 


oe 


Rt (i+1) =sqrt (ts(1,i+1)*2+ts(3,i+1)*2+ts(5,i+1)%*2) 
Rm(i+1) =sqrt (ms (1,i+1)*2+ms(3,i+1)*2+ms(5,i+1)%*2); 
R(i+1) =sqrt ((ms(1,i+1)-ts(1,i+1))*2+... 

(ms (3,i+1)-ts(3,i+1))*2+... 


(ms (5,i+1)-ts(5,i+1))*2); 


oe 


time (i+1) =time (i) +dt; 


% Rmiss check 


if (RL) © Rite) ) 


tcpa=time (i); %Time-of-C.P.A. 


break 
end 
end 


flop_count=flops; ; 


runtime=etime (clock, runtime) 


SF iling 
X=(ms(1,:)’ ms(3,:)’ ms(5, 
Y=[ts(1,:)’ ts(3,:)' ts(5, 


save cl3dm.dat X /ascii; 





a 





Range update 


Time update 


eae 
"]3 
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save cl3dt.dat Y /ascii; 
Printout 


plot (ttg(1l:i-1),R(1:i-1)); 


title(’Miss Distance vs. Time-to-go’); 


xlabel(’TTG [sec]’);ylabel(’Rmiss [ft]’); 


meta clgl 


pause 


clg 
plot (time,ts(1,:),time,ms(1,:)); 


title(’x-coordinate Time History’); 


xlabel(’Time [sec]’) ;ylabel(’x-coord. 


gtext (’Missile’) ;gtext(’Target’) ; 
meta clg2 


pause 


clg 
plot (time,ts(3,:),time,ms(3,:)); 


title(’y-coordinate Time History’); 


xlabel (‘Time [{sec]’) ;ylabel(’y-coord. 


gtext (’Missile’) ;qtext(’Target’) ; 
meta clg3 


pause 
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ip oe ae 


[ft )"y4 


clg 

plot (time,ts(5,:),time,ms(5,:)); 
title(’z-coordinate Time History’); 

xlabel (‘Time [sec]’);ylabel('z-coord. [ft]'); 
gtext (‘Missile’) ;gtext (’Target’') ; 

meta clg4 


pause 


clg 

plot (time,R) ; 

title(‘Miss Distance vs. Time’); 
xlabel(’Time [sec]’);ylabel(’Rmiss [ft]’); 
meta clg5 


pause 


clg 

plot (time,ts(2,:),time,ms(2,:)); 
title(’x-Velocity Time History’); 
xlabel(’Time [sec]’);ylabel(’Vx [ft/s]'); 
gtext (‘Missile’) ;gtext(’Target’) ; 

meta clg6é 


pause 


clg 


119 








plot (time,ts(4,:),time,ms(4,:)); 
title(’'y-Velocity Time History’); 
xlabel(’Time [sec]’);ylabel(’Vy [ft/s]'); 
gtext (‘Missile’) ;gtext(’Target’); 

meta clg7 


pause 


clg 

plot (time,ts(6,:),time,ms(6,:)); 
title(’z-Velocity Time History’) ; 
xlabel('Time [sec]’');ylabel(‘Vz [ft/s]’); 
gtext (‘Missile’) ;gtext(’Target’) ; 

meta clg8 


pause 


clg 

plot (time(1:i) ,rtod*gammam_pitch) ; 

title(’Missile Pitch Angle vs. Time’); 
xlabel(‘Time [sec]’);ylabel(’gammam_pitch [deg]’); 
meta clg9 


pause 


clg 


plot (time (1:i),rtod*gammam_yaw) ; 
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title(’Missile Yaw Angle vs. Time’); 


xlabel(’Time [sec]');ylabel('gammam_yaw [deg]’); 
meta clg10 


pause 


%%Following plots were not included in the documentation 
%clg 

plot (time (1:i) ,rtod*gammat_pitch) ; 

title(’Target Pitch Angle vs. Time’); 
$xlabel(‘'Time [sec]’);ylabel(’gammat_pitch [deg]’); 
meta clg13 

pause 

$clg 

splot (time (1:i) , rtod*gammat_yaw) ; 

$title(’Target Yaw Angle vs. Time’); 

txlabel (‘Time [sec]’) ;ylabel(’gammat_yaw [deg] '); 
smeta clgl14 


$pause 





clg 

plot (time(1:i),vc); 

title(’Closing Velocity vs. Time’); 
xlabel(’Time [sec]’);ylabel(’Vc [ft/s]’); 


meta cl1lg15 
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pause 


clg 

axis((tcpa-.1 tcpa+.1 0 min(R)+20]); 

plot (time,R); 

title(’'Rmiss "Zoom" Plot’) ;axis; 

xlabel (‘Time [sec]’);ylabel(’Rmiss [ft]’); 
meta clg16 


pause 


clg 

plot (time (1:i),am) ; 

title(’Total Missile Acceleration vs. Time’); 
xlabel(’Time [sec]’);ylabel(’am [ft/s*2]'); 
meta clg17 


pause 


clg 

plot (time (1:i) ,xddm) ; 

title(’'Missile x-Acceleration vs. Time’); 
xlabel(’Time [sec]’);ylabel(’xddm [ft/s*2]’); 
meta clg18 


pause 
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clg 

plot (time (1:1) ,yddm) ; 

title(’Missile y-Acceleration vs. Time’); 
xlabel (‘Time [{sec]’);ylabel(’yddm [ft/s*2]’); 
meta clg19 


pause 


clg 

plot (time (1:i) ,zddm) ; 

title(’Missile z-Acceleration vs. Time’); 
xlabel('Time [sec]’);ylabel(’zddm [ft/s*2]’); 
meta clg20 


pause 


Following plots were not included in the documentation 
$clg 

splot (time(1:i),at); 

$title(’Total Target Acceleration vs. Time’); 

%xlabel (‘Time [sec] ’) ;ylabel(’at [ft/s 2)" ys 

meta clg21 

pause 

sclg 

splot (time (1:i) ,xddt) ; 


$title(’Target x-Acceleration vs. Time’); 
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sxlabel (‘Time [sec]') ;ylabel(’xddt [ft/s*2]’); 
smeta clg22 

spause 

sclg 

splot (time(1:i),yddt) ; 

$title(’Target y-Acceleration vs. Time’); 
xlabel('Time [sec]’);ylabel(’yddt [ft/s*2]’); 
meta clg23 

pause 

%clg 

splot (time (1:1) ,zddt) ; 

stitle(’Target z-Acceleration vs. Time’); 
sxlabel(’Time [sec]’);ylabel(’zddt [ft/s*2]’); 
meta clg24 


$pause 


clg 

plot(ts (1,%)5¢8 (352). 3" ms (4,71..m8 (352) °9 5 
title(’xy-Plane Projection of Encounter’); 
xlabel(’x-axis [ft]’);ylabel(’y-axis [ft]’); 
meta cl1lg26 


pause 


clg 
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plot (time(1:i),CRE_yaw) ; 

title(’Yaw CRE’); 

xlabei('Time [sec]’) ;ylabel(’CRE_yaw [ft]’); 
meta clg27 


pause 


clg 

plot (time(1:i),CRE_ pitch) ; 

title(’Pitch CRE’); 

xlabel(’Time (sec]’);ylabel(’CRE_pitch [ft]'); 
meta clg2@ 


pause 


clg 

plot (time (1:i),CRE) ; 

title(’Total CRE’); 

xlabel (‘Time [sec]’);ylabel(’CRE [ft]’); 
meta clg29 


pause ; 


clg 
acmd=sqrt (acmd_yaw.*2+acmd_pitch.*2) ; 
plot (time(1:i),acmd); 


title(’Commanded Acc.’); 
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xlabel(’Time [sec]’);ylabel(’acmd [ft/s*2]'); 


meta cl1g30 
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